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Abstract 


The material presented herein is divided into three main 
areas of accomplishment. The first is a description of the 
Angle Only Docking Sensor concept and the computational re- 
quirements to develop useful guidance information from the 
raw angle only data. The second describes the analytical 
effort including the MIT in-house computer simulation, the 
development of guidance equations and vehicle stability re- 
lated thereto, and presents the results of studies covering 
the effects of employing Kalman filtering with the sensor 
under study. The third area presents the conclusions and 
recommendations resulting from the program. 

Much of the material herein has appeared in previous 
reports, but is included here for the sake of completeness. 
Section 1.1 includes new material indicating how the computer 
might operate to identify the individual sources in the target 
array. The guidance equations developed in Section 2.2 rep- 
resent the most significant increase in new material. Other 
more recently acquired information is included in the various 
related sections. 
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AUTOMATIC DOCKING STUDY 
Final Report 

1 . 0 The Angle Only Docking Sensor Concept 

1.1 Sensor Sub-System Description 

This automatic docking system embodies a sensor configura- 
tion which measures line-of -sight angles to energy reflectors, 
backscatterers or sources (hereafter called sources) uniquely 
mounted on another vehicle such as a space station (hereafter 
called the subject) . A priori knowledge of the location of 
the sources on the subject is required. The line-of-sight data 
is processed by special computation to develop range and atti- 
tude information which may be used directly with a guidance or 
monitoring system. Range-rate, attitude-rate, and other per- 
tinent parameters of dynamic geometry necessary for specific 
applications can be developed from the measured and computed 
data of this system. 

Because the measurement technique requires only angle in- 
formation, the hardware implementation of the sensor is expected 
to possess the advantages of simplicity, reliability, low weight 
and low power consumption. This measurement technique also pro- 
vides the desirable characteristic of more accurate solutions 
for range as the range to the subject is decreased. It is ideally 
suited for application in the docking of spacecraft, or for sta- 
tionkeeping between two vehicles in space. It further can be used 
during rendezvous and for horizon and star sightings. 

Figure 1 shows the geometry which exists between the sensor 

and the target. Positions 1, 2, 3, and 4 are the locations of 

the sources in three dimensional space. The vectors R. _ , FL „ , R 

12 1j 14 
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Figure 1 

SENSOR- SUBJECT GEOMETRY 
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SUPERSCRIPTS 

R - REFERENCE COORDINATES 
S - SUBJECT COORDINATES 

DOCKING AXES ARE DISPLACED FROM AND 
PARALLEL TO THEIR RESPECTIVE X-AXES 























R^ , R 24 ' anc ^ R 34 are s ^ own th e subject coordinate system 
between the sources and are pre-determined by design (see Figure 
2 ) . The sensor measures the azimuth and elevation angles (a^, 
e^) to each source and passes this information to a computer. 
Associated with each set of azimuth and elevation angles, e.g., 
with a^,'e , is a line-of -sight between the origin of the sensor 
reference coordinate system and the particular source. The 
lines-of-sight together with the vectors R , R. _ , etc. form 
triangles with a common vertex point at the origin of the sen- 
sor reference coordinate system. The computer functions to 
calculate the lengths of these lines-of-sight based on the 
vectors defining the source locations and the measured angles 



Ambiguities can exist when the sensor is required to oper- 
ate from all directions relative to the subject ( 4 n steradian 
coverage) . Under most circumstances the computer can develop 
unique solutions for the range to each source; however, the 
amount of computation and comparison required to obtain the 
solution becomes prohibitive. 

Analysis has shown that the volume of computational trial 
and error can be reduced considerably if system operating limits 
are defined and known, and the source configuration is designed 
to permit recognition of one source by its angular position 
relative to the other sources under all allowed attitude rela- 
tionships between source and subject within the defined opera- 
ting limits. See Figure 3 . Hence, it is not required that the 
sources be individually identified by the sensor, i.e., the 
system does not require that its sensor portion distinguish 
and relate a given source with its associated azimuth angle, 
elevation angle and line-of -sight. An intrinsic advantage of 
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Figure 3 

APPEARANCE OF SOURCES vs. ATTITUDE OF 
CONFIGURATION IN SENSOR COORDINATES 
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this system is its ability to compute relative distance, vel- 
ocity and attitude, without the necessity of signature infor- 
mation from the individual sources. Figure 4 presents a 
logic procedure by which the computer is enabled to identify 
the specific sources. 

The computer initiates its calculating process by selecting 
three of the four possible lines-of-sight along with three 
source position vectors, and three sets. of measured azimuth and 
elevation angles. At long ranges, the first set of three sources 
includes the three sources at the extremities of the source con- 
figuration simply to yield greater accuracy to the solutions. 

For close ranges, the computer drops the most extreme source 
and replaces it with the remaining source closer to the subject 
coordinate origin. The computer then increments through the 
three equations corresponding to the remaining sources and de- 
velops solutions for the range to all sources. Once the ranges 
to the sources have been ascertained, the computer develops a 
transfer matrix describing the orientation between the sensor 
and subject coordinate system. The matrix then provides the 
means of determining the existing Euler angles between vehicles 
and the subsequent solution for the range between docking hatches. 
Relative velocity and angle rates are then derived by averaging 
the difference between consecutive solutions for position and 
angle. 

There are several hardware configuration options for the 
sensor as well as mathematical procedures for solving the assoc- 
iated geometry. The source or reflector configuration may also 
have many forms depending upon the desired operational limits 
of range and aspect angle between sensor and subject. 
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Figure 4 

SOURCE IDENTIFICATION PROCEDURE 

Read y, z coordinates for each source/ ref lector return. 

Mark A Greatest "z" reading and corresponding "y" reading. 

Mark B Next greatest "z" reading and corresponding "y" reading. 

Mark C Next greatest "z" reading and corresponding "y" reading. 

Mark D Last "z" reading and corresponding "y" reading. 

Determine Ratios.- 

V z b V 2 e V z d Vfc V1 d Ib^d 

V y B ' V y C ' y C " y D ' V y C ' y A " y D ’ y B " y D 

Select ratios which are equal to within ± 1%. 

Size in descending order the Ay's for each of the equal ratios. 

Invert, if necessary to make all selected individual ratios >1. 

Com pa re ratios to 6. 25 10. 06. 

Accept ratios which fall within limits. 

The line with the largest Ay of the accepted ratios is terminated by sources #1 and #4 
The line with the smallest Ay of the accepted ratios is terminated by sources #1 and #2. 
The common source is #1. 

The extreme source is #4. 

The source between is #2. 

The remaining source is #3. 
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1.2 Sensor Configuration 

For automatic docking, an important requirement for the 
sensor is the capability to sense the multiple sources and to 
measure the angles of the line s-of -sight to them simultaneously 
or nearly simultaneously to prevent staleness of computed data 
and resulting control errors. 

The most feasible and readily available hardware configura- 
tions for this purpose are phototube devices. A vidicon can raster 
scan its entire field of view in several milliseconds and is 
quite suitable for the docking and stationkeeping operations. 

The sensor's usefulness can be increased to accomplish rendez- 
vous and star sighting and horizon scanning by replacing the 
vidicon with a high gain image dissector as the heart of the 
sensor receiver which can also perform the docking and station- 
keeping functions. 

1.3 Source/Reflector Configuration 

The configuration of the sources or reflectors is dependent 
upon many conditions: 

a) the size and shape of the subject vehicle or structure, 

b) interference with other equipment - either physically 
or by radiation, 

c) the amount of spherical coverage about the subject 
vehicle required for sensor operation, 

d) sensor field of view, resolution, and accuracy at 
minimum and maximum operating ranges. 

Although the source arrangement can be designed to operate 
over a complete sphere of 477 steradians, such an operational 
requirement is highly unlikely and usually unnecessary in 
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practice. In fact, judicious choice of the angular operating 
region of the system results in computational simplification. 

This point is illustrated by the configuration of Figure 2 
which assumes no conflict with conditions (a) and (b) above 
but which is designed to operate with a sensor always within 
a ±30° cone symmetrically oriented about the subject vehicle 
axis, for example, with the apex of the cone at the docking 
hatch. Based on this operating region, the vectors R R.._, 

X ^ XJ 

Rf 4 have been selected to assure that the vectors between 
sensor and sources (Figure 1) will always satisfy the rela- 
tionship R^ < R^ , r 2 < R 3 ' R 3 < R 4 * The solution for these 
ranges may now be obtained by computing single roots rather 
than all eight roots to each set of equations as described on 
pages 12 and 13. 

Further computational simplification occurs if the indi- 
vidual sources are arranged to permit their unique identifica- 
tion within the 60° operating cone by their relative location. 

To illustrate this possibilty. Figure 3 shows patterns resulting 
from the particular choice of source locations of Figure 2 when 
viewed by the sensor at the center and at 8 extreme locations 
about the cone. Certain characteristics of the pattern persist 
despite subject vehicle attitude changes within the operating 
cone. For example, sources 1, 2, and 4 are always along a 
straight line with point 2 between points 1 and 4. See Figure 
3. By recognizing these pattern characteristics, the need for 
computer guesswork in selecting the lines-of-sight to the various 
sources is reduced or avoided, thereby eliminating the additional 
computation associated with trial and error and allowing the 
relative geometry to be solved with only one set of equations, 
i.e., using only three source lines-of-sight for the solution. 
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Thus the configuration shown provides the sensor and its comp- 
utational system with the ability to associate the proper 
lines-of-sight to each source and to solve for the range to 
each source unambiguously, within the limits of sensor angle 
accuracy. Again Figure 4 illustrates a possible logic proce- 
dure for source identification. 

This configuration also offers another advantage to the 
sensor -computer system in consideration . of condition (d) . 

The lengths of ^ 13 ' ^14 ma ^ ke se l ecte d to allow more 

accurate solution at maximum ranges by choosing large dis- 
tances between points 1 and 3, and 1 and 4. In a docking 
operation where the distance between vehicles continues to 
decrease after alignment and an aim point position have been 
achieved, the sensor -computer system can, at the proper range, 
drop the larger line-of -sight angle source 4 and operate with 
sources 1, 2, and 3, thereby reducing the sensor field of view 
requirement. 

1.4 Computation 

Several approaches for solving the geometry exist. One 
method is to employ vector analysis. The sensor supplies the 
e i? a^, e^; a^, e^; a^, e^) to the four sources or 
reflectors as shown in Figure 1. For -the purpose of this ex- 
ample it is assumed the sensor cannot differentiate between 
sources, but can pair the azimuth and elevation angles prop- 
erly. 

Each angle existing between the lines-of-sight is com- 
puted: 

cos Q. . - (unit R.) * (unit R.) 

ID 1 D 


angles (a^ f 
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or 


cos (9. . = cos a. cos e. cos a. cos e. 

13 1133 

+ sin a. cos e. sin a. cos e, 
1x33 

+ sin e . sin e . 

1 3 

The computer solves for the cosines of all angles between 
the lines-of-sight as viewed from the sensor: 

e i2' °13 ' °14' °23* and 0 34 

The equations for solution of the triangles reduce to the 
law of cosines: 


Set X (1-2-3-1) 


R 2 = 
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Set ill (1-2 -4-1) 



and respectively, see Figure 1, and where R^ 2 ' R ^ 3 » R^ 4 , R 23' 

R 24' R 34' are the ma< ?nitudes of vectors § 12 , R 13> R 14 , ^23' R 24' 
R 34 respectively. The sets of equations each have eight possible 
solutions. However, as noted in Section 1.3, if the sensor is 
located within a predetermined cone whose apex is at the subject 
coordinate system origin and the cone axis is coincident with 
the subject -X* -axis and the sources are located on the subject 

in a manner which causes the vectors R^, ^13 ' ^14' R 24' an< ^ R 34 
to have angles with respect to the x-axis of the subject coordin- 
ate system that are less than the complement of the cone radius 
angle, the eight roots of each set of equations reduce to a single 
root in each case. 

Thus with an operating cone of 60° diameter and with the 
source configuration vectors (R^ 2 , R^ 3 » etc ) properly selected 
as, for example in Figure 2 where R^ < R 2 / R 2 < R 3 and R 3 < R 4 
will always be true, the multiple roots can be eliminated sim- 
plifying the equations to: 

Set I 



12 






The fourth source is present for two reasons. The first 
is to provide the sensor system with an option for choosing the 
best combination of three sources for solution of a triangle 
which yields the more accurate range results, or to select 
sources which fall within the sensor field of view at close 
ranges . 

The second reason relates to the general case where the 
individual sources are not identifiable, either by signature 
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or by their relative position in the configuration pattern as 
viewed by the sensor. Under these circumstances the fourth 
source allows the development of three sets of equations in 
order that the computer can check for possible ambiguity in 
the solutions for range. Hence two sets of equations should 
be solved and agreement between solutions achieved to insure 
that the correct solutions have been attained. 

The configuration described in Section 1.3 provides a 
means for the computer to identify all sources and avoid the 
need for computing and comparing results for more than one 
set of three sources to obtain unambiguous ranges to the 
sources. 

One procedure for solution of the simultaneous equations 
is to let equal the maximum operational range for the device 
and solve for R^, R 3 , and/or R 4 as the case may be. The solu- 
tion for R^ is compared with the input value for R^ and the 
difference taken. The input value of R^ is then decreased 
by 50%, for example, and another computation made. Again 
the "R^ in" is compared with the "R^ out", the difference 
taken and the difference tested for polarity change. If no 
polarity change occurs, the "R^ in" is again reduced to 50% 
of its last value and the procedure repeated until a polarity 
change in the difference occurs. 

When the polarity change does occur, the last selected 
value for "R^ in" is increased by 50% of its value and the 
polarity of the difference between "R^ in" and "R^ out" is 
tested. This procedure, increasing or decreasing "R^ in" by 
50% of each increment taken, is repeated until the difference 
between "R^ in" and "R^ out" is consistent with the desired 
error level. 
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Faster convergence to a solution for the ranges can be 
realized if interpolation or extrapolation techniques are 
employed should the real time consumption be undesirable. 

Once the ranges have been obtained, the solution for 
the relative attitude between the two vehicles can be achieved. 
By definition, the following angles represent the rotation of 
the subject coordinates with respect to the reference coordin- 
ate system: 

y - rotation about the x-axis 
y 2 - rotation about the displaced y-axis 
Y ^ ~ rotation about the displaced z-axis 

A transfer matrix, M, describing the relative attitude 
between sensor and source coordinate systems may be developed. 


where 



M = M 

z 

M M 
y x 



cosy 

sinY 3 

0 

M = 
z 

! -siny 

i 

cosy 3 

0 


i 

1 0 

0 

1 


cosy 2 

0 

-sinY 

M = 
Y 

0 

1 

0 


I siny 2 

0 

cosy 
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0 


M = 
x 


0 cosy^ siny 1 


0 -siny 1 cosy^j^ 


where 


M = 


m 


m 


11 

m i2 

m i3 

21 

m 22 

m 23 

31 

m 32 

m 33 


m 


m 


m ll = COSy 2 COSY 3 

m ^2 = siny 1 siny 2 cosy^ + cosy^ s ^- n y 3 
m 13 = -cosy^ siny 2 cosy 3 + siny^ siny 3 

m 21 = “ COSY 2 sinY 3 

22 = -siny^ siny 2 siny 3 + cosy 1 cosy 3 

23 = cosy^ siny 2 siny 3 + siny 1 cosy^ 

m 3l = SinY 2 
m 2 = -sin Yl cosy 2 

m 33 = cosy^ cosy 2 

The placement of the sources in subject coordinates is 
described by the vectors: 

S 12' *13' *14' *23' *24' and *34 aS shown in Fi 9 ure 2 * 
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Let represent one of the vectors which exist between 

the subject coordinate system origin (source X) and any other 
source on the subject. 

-R T-S 

R , = M R . 
ll lx 


or 


„ -R -S 
MR, = R , 
lx lx 


where the superscript identifies the coordinate system in which 

T . 

the vector xs resolved, and M Xs the transpose of M. 


M 




| 





1 

r r 

*12 
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R* 

*13 

1 

R* 

*14 
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R S 

*12 

J s 
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R S 

*14 
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-S 
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R^ 

13 
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14 


r r 

12 


r r 

*13 


r r 

R 14 


-1 


From Figure 1: 


*12 “ R 2 


R l' *13 *3 


R 1# and R = R 4 - R ] 


In certain special cases such as the configuration shown 
in Figure 2, where R is shown in line with and parallel to 

— -R _R ^.g «,g 

R , the cross products, R.. n X R,_ and R X R, - , must be used 

fz _g lz 13 12 i.3 _ 

in lieu of R^ 4 and R^ 4 respectively since the use of R^ would 
not allow completion of the matrix. 

The solution for M above determines the angles y^, y£ 
and y_ which are solved as follows: 

sin Y2 - m 31 
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and 


siny 3 



COSJ 2 


B 


sin Yl 


m 


32 


cosy. 


If any of the above angles are allowed to exceed 90° in 
magnitude, it is required to solve the following equations as 
necessary to avoid ambiguous answers. 


and 


m 


cos 


Tl 


33 


COSy 2 


m 


cos 


^2 


21 


sxn Y3 


m 


cosy 


11 


3 cosy. 


Finally, the position vector, R, between the docking hatches or 
other location, such as an aim point, can be computed in the 
reference frame as follows: 



+ M 


T 



R 

SD 


The information thus derived from this technique is now suffic- 
ient for a guidance system to control its own vehicle in any 
desired position or orientation with respect to the subject 
vehicle. 


Another technique for solving this geometry is to employ 

* 

the Law of Sines where again three sets of three equations are 
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developed allowing a solution for the ranges to be accomplished 
by methods similar to those previously described. 

Iterative and other incrementing techniques can be employed 
to obtain solutions for the ranges, Euler angles, and relative 
position of the two vehicles or object. 

Although the sensor coordinates have been used as the ref- 
erence coordinates in this description, any convenient coordin- 
ate system can be selected as coordinates to accommodate specific 
applications. 1 
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2.0 Analysis Accomplished 

2.1 Computer Simulation 

Completion of the definition of the overall computer 
simulation program was accomplished. As presently configured 
in Figure 5, the simulation will evaluate the angle only 
sensor performance without the benefit of filtering or esti- 
mation techniques. It is further recognized that the random 
number generator is not a fully representative error model 
for the sensor. Boxes (2), (3), and (5) were completed and 
applicable flow charts are presented in Figures 6 through 10. 

Consideration was given to the capability of simulating 
inputs from other type sensors, however this was not incor- 
porated because of time and funding limitations. 

In the interests of obtaining as much information about 
one sensor concept and the guidance laws selected, it was 
decided to proceed with the simulations as described. 

Figure 6 shows that portion of the overall proposed 
simulation (Figure 5) which was programmed. Figures 7 through 
10 support the information in Figure 6 by presenting in detail 
the logic necessary to accomplish the final results. 

The purpose of the routine AZELUP (Figure 7) is to gen- 
erate accurate solutions for the range, azimuth, and elevation 
to each source, given the range between the docking hatches, 

R and relative vehicle attitude. This operation thus computes 
H 

the true values for the ranges which are used for evaluation 
purposes and the true values for azimuth and elevation angles 
which are fed to a summing network and to which are added 
instantaneous error signals from a random number generator. 
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i Rate Calculation 
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Fig. 6 MIT Computer Simulation Programmed 
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Normally distributed 
psuedo- random number 
tfi.th mean zero and 
std. deviation = a 


Fig, 7 AZELUP Subroutine 
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Fig. 10 Rate Calculations 


28 















This latter activity thus simulates the sensor accuracy 
characteristics. The portion of the simulation which computes 
the value of the angles between sources and the ranges to the 
sources and the portion which develops the Transformation 
Matrix, solves the Euler angles and computes the range R„, 
between docking hatches and the angle and range rates all have 
results dependent upon the errors introduced by the random 
number generator. 

Several runs were made using the operating portion of 
the direct (unfiltered) simulation. These tests verified the 
functional feasibility of the computer programs designed to 
accept the raw sensor data, compute the ranges to the targets, 
and develop the relative position and attitude between vehicles. 
The sensor was initially located on the passive vehicle docking 
hatch axis 305 feet distant from source number one of the array 
shown in Fig. 2, i.e. R 1 = 305 feet. The initial closing rate 
was 10 feet per second, and at 40 feet distant reduced to 5 feet 
per second, at 9 feet to 1 foot per second, and at 8.9 feet to 
0.1 foot per second. 

Table 1 presents the results of a run made under the above 
conditions using target sources 1, 3, and 4. A single set of 
readings was made at each relative range sampled. The pre- 
sentation shows the expected result of improved accuracy as the 
range decreases. The lateral position errors are considerably 
less than the track errors at long ranges. The track errors, 
however, improve much faster than the lateral errors as range 
decreases and at dock (when R^ = 5 feet) all orthogonal errors 
are of the same order of magnitude. The velocity, angle, and 
angle rate errors are consistent with the position errors and 
show vast improvement as range decreases. 

It should be remembered that the target array dimensions 
were not optimized for the geometry studied and that sensor 
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scale change was not implemented to compensate for the large 
dynamic range covered during the run. It is precisely these 
parameters that must be optimized for a given docking profile 
and geometry. Section 2.3 describes the improvement reali- 
zable using Kalman filtering which in addition to sensor/tar- 
get parameter optimization makes the angle only sensor system 
appear feasible for SSV docking. 

2.2 Guidance Law for Spacecraft Docking 

2.2.1 General 

There are two separate guidance phases involved with 
the docking operation. The first phase is the guiding of the 
sensor vehicle from a location near the edge of the operating 
cone at some large range to an aim point several hundred feet 
in front of the subject vehicle docking hatch on the docking 
axis. During this period, simultaneous control of both posi- 
tion and attitude of the sensor vehicle is desirable to in- 
sure that protrusions such as wings, arms, etc. from each ve- 
hicle do not interfere or collide, and to insure arrival at the 
aim point with the proper attitude. Figure 11 shows the desired 
docking profile for this phase. 

The requirement for simultaneous control in translation 
and attitude and the establishment of an acceptable time both 
for arrival at an aim point and for the complete docking oper- 
ation, make this guidance law somewhat unique and different 
from currently employed guidance laws . A very significant 
aspect of the law is the controlling of the vehicle attitude 
and attitude change in order to optimize convergence time with 
minimal expenditure of fuel. It is desirable to set up an 
initial rotational impulse about all three vehicle axes such 
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that upon arrival at an aim point a second set of impulses will 
reduce the rotational rates to zero with the vehicle attitude 
aligned for completion of the docking operation. An important 
parameter in docking guidance is the sensor vehicle angular 
momentum which, in the absence of external forces, remains 
constant as the vehicle rotates. The final equations for the 
guidance provide for the control of angular momentum rather 
than angle velocity. 

The second phase, operating from the aim point to hard 
dock, also requires vehicle control in both position and atti- 
tude. However, the excursions in attitude and in position are 
expected to be small, requiring less correction energy than 
those of the pre-aim point phase. The range rate profile will 
call for the decreasing of approach velocity and corrections 
for small off-axis velocity build up as the sensor vehicle 
closes with the subject. 

The guidance law should impose one additional restriction? 
the source array on the subject vehicle must be maintained 
within the field-of-view of the sensor at all times during 
the entire convergence operation for safety reasons. Computer 
runs have indicated that the sensor x-axis and the line-of -sight 
to the target array become misaligned during the simultaneous 
translation and rotation maneuver. 

This study also considered a simplification of the guid- 
ance law. The most likely scheme was to initially roll the 
SSV such that its +z-axis would intersect the Space Station 
docking hatch axis line and then continue with rotation about 
the pitch axis only until an "Aim" point had been reached where 
another roll maneuver would place the SSV into proper orienta- 
tion at this "Aim" point. The advantage that this technique 
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has is that angular velocities can be controlled directly 
rather than the need to control overall angular momentum. 

The principal disadvantages are that additional iv is con- 
sumed to perform the two separate roll maneuvers, rotation 
about the axis of intermediate inertia (the y or pitch axis) 
is unstable, and the fact that all errors are not simultan- 
eously reduced. This latter situation could create a mis- 
alignment condition just as docking occurred; however, since 
the errors should be small at that point, this may not be 
too serious. 

2.2.2 Guidance Equations 

2. 2. 2.1 Guidance Law Employing Simultaneous Translation and 

Rotation 

The translational portion of the motion is reasonably 
easy to implement since the relative velocity and the linear 
momentum should be along the displacement vector. The rota- 
tional part of the motion is more difficult to analyze. An 
untorqued body rotates with constant angular momentum which 
(unless the three moments of inertia are equal) does not in 
general lie along the angular velocity. The parallelism of 
velocity and momentum applies to translational motion but 
not rotational. 

The shuttle 1 s three principal moments of inertia are 
unequal and its untorqued motion can be exactly described 
by elliptic functions. However the equations are somewhat 
involved and perhaps it is not necessary to use exact equa- 
tions since there are errors associated with the sightings 
taken during the motion and corrective thrusting may occa- 
sionally be required. Two of the shuttle's moments J and 
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j are nearly equal and each is about ten times J . If J 
z x z 

exactly equaled J^, then the rotational motion would be des 
cribed by 


0^ = H/J^ (constant) 
02 = constant 


( 1 ) 

( 2 ) 


' X 

where H is the angular momentum magnitude and 0^, d^, and 0^ 

are a set of angles relating the shuttle axes and a set of 

inertial axes. It is proposed to use this description of 

the rotation as a reference and then, if increased accuracy 

is desired, to perturb these equations using the quantity 
J - J 

2 y as a parameter. 

J x 

ROTATION OF A SYMMETRIC BODY (J — J ) 

y z 


cos0 . (constant) 


( 3 ) 


The preceding equations are derived as follows. Let H 
denote the angular momentum of the shuttle about its center of 
mass. Then H = jw where J is the shuttle's moment -of -inertia 
tensor and co is the shuttle's inertial angular velocity. The 
dynamical law of rotation states that the inertial derivative 
of H is the sum of the torques T acting on the body, H = T or 

Joo + oo x J to = T 

Here the first term is the derivative of H with respect to 
shuttle axes and the second term is the Coriolis correction. 
Variations of J with respect to the shuttle are ignored. The 
components of this equation along principal axes are the Euler 
equations 
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J CO 
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(J 

II 
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X X 
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y y z 


J 03 

+ 

(J 
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II 

T, 

y y 


X 

Z Z X 


J 03 

+ 

(J 

II 

3 

3 

T 

z z 


Y 

x x y 


absent 

and if 

j equals » 
z 

T 

y 




J 0) * 

0 




X X 


J co 

_ 

(J 

- J ) 0) 0) = 

0 

y y 


Y 

X x z 


J £ 

+ 

(J 

* j ) 0) 0) = 

0 

y z 


Y 

x x y 



( 4 ) 


(4 a) 


Then oo remains constant at its initial value m and 
x x 0 

& y - Cw z = 0 


K + Cw y " ° 


(4b) 


where 


c ■ (1 - r>“x 

Y 


CO = CO 

X X, 


(4c) 


The solution of the differential equation is 


co = co co sCt +to sinCt 

Y Y 0 0 


oo = -co sinCt + co cosCt 
z v~ Z„ 


(4d) 


When the torque is zero, the shuttle's angular momentum is 
constant. Define an inertial axis system x jY-j- z -|- with x^ 
along the constant H and y and z^ perpendicular to H (the 
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latter two axes need not be more explicitly defined here) . 
Let 0^, 0^, and 0^ be the set of Euler angles relating the 
shuttle ajces xyz to X I Y I Z I where 0^ is measured about H, 0^ 
is the angle between this vector and the shuttle's x-axis, 
and 0^ is measured about the latter axis. With 

0^ about x^ 

0^ about intermediate y 
about ( shuttle 1 s) x 


The matrix P of direction cosines from XjYjZj to xyz is 
obtained as the product 



( 5 ) 



where the remaining four entries need not be calculated. The 
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inertial angular velocity w of the shuttle is the vectorial 

sum of the Euler angle rates about their respective axes. Thus 

• • 

w - 0^i + 0 2 (jcos02 - ksinO^) 

+ 0^(icos0 2 + jsin0 2 sin0 2 + ksinO^os©^) 

where the components of the 0 1 and © 2 axes are given by the 
first and second solumns of the first matrix in (5) . The 
components of to are 


0) = 

e.cos0 o + e. 


(6) 

X 

12 3 


0) = 

• 

0 , sin0„sine_ 

• 

+ e cose. 

(7) 

y 

12 3 

2 3 

00 = 

.m 

0, sin0^cos0 . 

• 

- 0 sin 0 

(8) 

z 

1 2 3 

2 3 


The angular momentum H is 

H = Hl I 
or 

H = H(Icos6 2 + j sin 0 2 sine 3 + ksine 2 cose 3 ) 

Thus 

H = J a) = Hcos0. 

XXX 2 

H = J to = Hsine sine (9) 

y y y 2 3 

H = J to = Hsin0 o cos0 
z z z 2 3 

Since to is constant, it follows that 0. is constant. It is 

x . . ^ 

next shown that 0 and 0 are constant. Let K denote the dot 

X J 

product of w and 5. (This quantity is twice the kinetic 
energy of rotation.. ) 
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- — 2 2 2 
K = go • H = J a) + J a) + J a) 
xx y y z z 


In terms of row and column vectors. 


-T - 

K = 0) JO) 


Differentiating, 


K = a) Jgo + a) Ju) 


K ^ (w J oo) 1 + go jo) 


Since j is symmetric 


-T A - A 

K = 2 go Jgo = 2 go • Jgo 


Adding a quantity which is identically zero gives 

.« • 

K = 2 to * (J io + <o x jJJ - ) 

But the term in the parentheses is the torque which is assumed 


to be zero. Thus 


K = 2 co • T = 0 


and K is constant. Substitution of (9) into (10) gives K in 
terms of Euler angles, 

T . T 2 H 2 . 2 0 . 2 0 , H 2 . 2 q 2 n 

K = J co + —sin 0 sin 6_ + —sin 9_ cos 0„ 

XX J 2 3 J 2 3 

y z 

and since J equals J , 

z y 

2 H 2 . 2 

K = J jo + —sin 0 (11) 

X X u Z 

y 

This result is used in a later equation. Multiplying (7) by 


* " T " is used here to denote the transpose of a matrix as differentiated 
from torque in equation (4) preceding, and otherwise explained. 


39 



sin (8) by cos0 3# and adding gives 

a) sin0„ + 0) cos 0_ ■*. 0. sin6 
y 3 z 3 1 2 

Multiplying both sides of this equation by Hsin0 2> 

• 2 

o) Hsin0_sin0_ + 03 Hsin0 o cos0 = 0,Hsxn 0_ 
y 2 3 Z 2 J x x 

and substituting from (9) , 

2 2 * . 2 . 

J to + j 0 ) = 0 -Hsxn 0 

y y z z 1 2 


or, from ( 10 ) , 


2 * .2 
K - J o) = 0 ,Hsxn 0 . 
xx 1 


and from ( 11 ) , 


so that 


sin 2 0 2 = e 1 Hsin 2 e 2 
Y 



(12) 


which is constant. It follows ( 6 ) that 

• • 

0 = 03 - 0 COS 0_ 

3 x 1 2 

and 0 is constant. Another formula for 0_ is derived below. 
3 J 

From the first of (9) , 


e = 7^ose 2 - j ! oos9 2 
x y 

or 

1)COS0 2 

y x 


( 12 a) 
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and 


. . J 

0 3 = V/ ‘ 1,oose 2 

X 


(13) 


The result that the angle 0 and the angular rates 0 and 6 

(bi JL < 

are constant for a body with two equal moments of inertia 
(j^ and J^) in the absence of torques gives rise to the des- 
cription that the x-axis rotates at constant angular rate 

« 

( 0^) about and remains at a fixed angle (0^) from H (thereby 
tracing out a cone) while the body is rotating at a fixed 
rate (0^) about its x-axis. 

DETERMINATION OF THE ANGULAR MOMENTUM 

The preceding section shows how the continuing rotation 
of an untorqued symmetric body may be obtained when its initial 
orientation and angular momentum are given. For the present 
problem, the initial and final orientations are given and it 
is necessary to find the angular momentum vector required for 
achieving the final orientation. 

If the initial values of 0 and 0 are defined to be zero, 
* * ^ 

the final values 0 1 and 0^ are obtained, by integrating (12) 
and (13) , as 


* 



®3 = 6 1 ( J X “■ 1)cos0 2 (14) 

X 

* 

where t is the time of flight. Let a denote the angle between 
the initial and final x-axes and <j) be measured about the final 
x-axis. These angles constitute a sequence of two rotations 
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taking the shuttle from its initial to its final orientation. 
Let 3 be the angle between the angular momentum vector and 
the plane containing the initial and final x-axes. Geometrical 
considerations show that 


* * 

0 . 0 , - 4 > 

1 3 a 


1 

3 a 

(15) 

cos-j = 

cos 2 x ~‘ OS 2 

* 

. \ 

sin— ^cos 

* 

0 3 “ +• 

= -sm 2 

(16) 

* 

. 9 1 . 

sin-rsm 

6 

* 

3 . a 

- cos-— sin— 

(17) 

COS 0 2 

= COSMOS 3 

(18) 


The preceding four equations along with (14) provide a solu- 
tion for angles 6*, 0*, 6*, and $ and then H is given by 

* 

h = - 4 1 

t 

It should be noted that (15), (16), and (17) constitute a 

dependent set of equations because the sum of the squares of 
their left-hand sides is one. These equations are derived 
below. Let I denote the initial x-axis and I' denote the final 
x-axis of the shuttle. Let 

k' = unit (i x i' ) 

j' = k* x i' 

The angles a, 3, and 0 2 are illustrated in figure 12. The 

vector I’ is obtained by rotating i about the unit angular 

* . 

momentum i through the angle 0 The equation of this rota- 
tion is 
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( 19 ) 


. ^ & 
I' = I + I x lsin.0^ + x a x x i) (1 - cose^) 


Dotting this equation with i^ gives 


or 


ij • i' = i • i 


i- * (i‘ - i) = 0 


Dotting the difference i 1 - i with the sum i' + i gives 
(i 1 + i) * (i 1 - i) = i* • i ' - i • i = 0 

Finally 

k' • (!' - i) = 0 

Because these three dot products are zero, 

k' is perpendicular to i 1 - I 
i + i' is perpendicular to i' - i 
I is perpendicular to i' - i 


and ij lies in the plane of k' and i' + i. But i 1 + i lies 
along the angle bisector of i' and i. Therefore: 


i^ = i'cos^cosg j * sin^cosg + k' sing (20) 

There are defined two sequences of rotations taking the shuttle 

from its initial to its final orientation. The first one is 

angle a about k' followed by angle <j> about i' where these 

angles are specified by the two orientations. The second se- 

* _ * _ 
quence is angle 0 about i followed by 0 about i' . The 

JL JL w 

latter two angles along with g , the elevation angle of i^ with 
respect to the plane of i and i' , are to be determined. 
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The rotation between the two orientations is given by the 
quaternion product p^p^ where 

p^ = coSj" + I'sin|- 

a , .a 
P a = cosj + k' sm— 

The rotation is also given by the product where 

* * 

^3 : e 3 

p - cos-T + 1 sin— 


Thus 


or 


* * 

6 1 - 9 1 
Pi = cos T + i i sin T 


P 3 P 1 = P tf) P a 


P 1 = P 3 P <j> P a 


This expands into 


P x = (cos— 


e 3 , _ , 

X* sin—) (cosj + I'sin|-)p a 


or 


* 

e 3 - * 


9 3 - * 


a 


a , 


p^ = (cos — - i'sin— 2 ■) (cos— + k 1 sinj) 


so that 
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and (15) through (17) are verified. Since 0^ is the angle 
between i' and i , cos0 is the dot product of i' and i , 

J- ^ JL 

and (18) is produced by dotting (20) with i' . 

NUMERICAL SOLUTION OF THE EQUATIONS 

It is impossible to solve (14) through (18) analytically, 
so a numerical technique was devised. Division of (16) by (17) 
and (17) by (15) gives 
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(21) 


* 

0 _ - cf> 

3 . a 0 

tan — = -sxn— cotP 


1 a 

tanr-j- = tan^csc3 


and substitution of (18) into (14) yields 


* * u v 

e = e (-x 

3 l v J 

x 


1) cos^cosS 


For a given a and 4> , 3 is allowed to vary in the range 

o * * 

0 < 3 < 180 until the solution for q and 0 3 from ( 22 ) and 

(21) satisfies (23) . 

This range for 3 is chosen so that a £ 0* ^ 180°, that 
is, the shuttle's x-axis moves from its initial to it final 
orientation in the smaller of the two angles about the cone. 
This is proved as follows. The inverse of (19) is 

i = i' - ij. x I'sinO* + x <1 x I*) (l - cosQ*) 

(which describes a rotation of I’ about -I through the angle 

, * *• 

0 1 ) or 

i = i* - ij x I'sin0 1 + [Jl^. • I , )I ] . - I J (1 - cos6 1 ) 

Dotting this equation with k' gives 

•mm mm "fc mm ■ ^ 

0 = i I X i' • k'sin0 1 + (1^. * I') (X^ ♦ k') (1 - cosB.^ 


-I I • j'sino^^ = (i J * x' ) (X I * k')(l - cos0 1 ) 
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Evaluating the dot products from (20) yields 


Ot * 

sin-^cosgsin©^ 


cos-^cosgsing (1 - cos0^) 


or 

* 

sinG. 

• o 1 , a 

sin 6 = j-tan— ■ 

1 - COS0^ 

so that 

* 

0 

1 a 

sing = cot— ^tan— > 0 

A computer program was written to check the existence of 
solutions of the equation. This program was run for a equal 
to 30° and <J> taking on values at 10° steps in the range 

-170° <1 <J> * 170° 

For each case there is at least one, usually two, and occa- 
sionally three solutions for the angular momentum. It is 
assumed that similar results occur for a shuttle with un- 
equal moments of inertia, but this should be checked. 

The display of lights on the space station should remain 
within the field of view of the sensor on the shuttle during 
the latter's rotation and translation. The program was ex- 
panded to test this aspect of the motion. An initial range 
of 1000 feet and final ranges of 300 feet, 500 feet, and 866 
feet were chosen for the aim point. 
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Final x-axis 



Figure 13. Conversion Geometry to Aim Point. 


These runs indicate that the magnitude of maximum misalignment 
during coast is dependent upon the location of the aim point 
relative to the initial relative position of the shuttle. For 
example, if the shuttle is located at the edge of the +30° cone 
surrounding the docking hatch axis of the passive vehicle and 
is 1000 feet distant, the deviation between the LOS and the 
sensor axis will become as high as 9 degrees during the simul- 
taneous translation and rotational maneuver when the aim point 
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is located 300 feet in front of the passive vehicle docking 
hatch. When the aim point is roughly at the same range as the 
shuttle from the passive docking hatch the maximum deviation 
can be held to less than 3 degrees. 


APPROXIMATE ROTATION OF AN ALMOST SYMMETRIC BODY 




A method of determining the rotation of a body with two 
nearly equal moments of inertia is presented in this section. 
It consists of a first-order perturbation of the angular vel- 
ocity equations for a symmetric body followed by the change in 
rotation caused by a perturbed angular velocity as described 
in the preceding section. 


The perturbed equations corresponding to (4) preceding 
are (in the absence of torques) 

J (go + Ad) ) + Aj (go + Ago )(go + Ago ) — 0 

x x x y y z z 

J ( go + Ad) ) + (J - J - AJ) (go + Ago ) (go + Ago ) = 0 

y y y x y z z x x 

(J + Aj) (go + Ago ) + (J — J ) (go + Ago ) (go + Ago ) — 0 
y z z y xx x y y 

where Aj = J - J 
z y 

Subtracting (4a) from these equations and retaining only the 
first-order terms gives 

j x A(L x + AJu) y G) z = 0 

JyA^ y - (J y - J x ) (w z Ao) x + w x Ao) z ) - AJg) x gj z = 0 


AJo) + J Ao) + (J - J ) (o> Aw + a) Aw ) = 0 
z y z y x y x xy 


or 



— £ 0 ) 0 ) 
x y z 
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A “y " rw x Aa) z " rw z Aa) x " e y to x w z “ 0 


A “z + rw x Aw y + r '°y Aw x ” e y Cto y " ° 


where 


= M 


= M 


x J ' y J 
x y 


J - J 

r = — — 


( 24 ) 


and o) z is replaced by as obtained from (4b) . The first of 

the differential equations becomes, from (4d) 


z o “y 0 

Aw — — £ (to w cos2Ct + sin2Ct) 

x x y 0 z o 2 


which integrates into 


Aw = E,cos2Ct + E„sin2Ct - E, + Aoo (0) 
x 1 2 lx 


(25) 


where 


to 


to. 


E 1 = 


'0 


4C x 


E 2 " 


*0 0 
2C £ x 


By appropriate use of the imaginary unit, the second and 
third differential equations become 

Ato y + irto x iA(o z + irito z A(o x = e y w x o> z 
iA<o z + irw x A(o^ + irco y Aw x = ie y c <o y 


Letting 


to — oo„ + i w / Aoo - A to + iAoo 
y z y z 


addition of the differential equations produces 
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Aw + iJAu) Aw + iFwAw = £ (w w + iCw ) 

x x y x z y 


or 


Aw + iCAw = -ir.wAw + e w (w + iF w ) 

x y x z y 


( 26 ) 


where from (24) and (4c) 


C = Tw 


x 


ict 

Multiplying (26) by e gives 


d, iCt . iCt 

— (e Aw) = e 
at 


-iFwAw + e w (w + irw ) 
x y x z y 


(27) 


which integrates into 


1 P+- 

e Aw = \ f (x) dx + Aw(0) 


where 


f(x) ^ e 


iCt 


■iFwAw + e w (w + iTw ) 
x y x z y 


Thus 


Aw = e 


-ict 


| F ( t) + Aw(0)j 


where 


F ( t) = \ f( T )d T 
o 


(28) 


Letting F^(t) and F z ( t ) denote respectively the real and im- 
aginary parts of F, it follows from (28) that 

= (cosCt - isinCt) { P Y (t) + Aw^(O) + i [jz (t) +Aw z (°)| 


and 
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Aw = 

F (t) + Aw (0)1 

cosCt + 

R(t) + Aw (0)1 

Y 

L y y _j 

r ~l 


L z z j 

i — * — i 

Aw = - 

F (t) + Aw (0) 

sinCt + 

F (t) + Aw (0) 

z 

Ly Y j 


L z z J 


The formulas (25) and (29) may be substituted into (46) 
to obtain the perturbed rotation Ap. From (47) (see section 
2. 2. 2. 2 following from equations (46) and (47)): 

— B — 1 — 

pAw p ’ — MAw (30) 

T 

where, for the present problem M is to be replaced by P where 
P is given by (4e) and (5) and can be expressed by: 

m rn m rp m 

P - < P 3 P 2 P 1> “ P 1 P 2 P 3 < 31 > 


where 




P 1 - 


P 2 = ° 


COS0 1 

sin0 

-sine i 

cose 

o 

CM 

-sine 

l 

0 

o 

CM 

cose 

0 

0 

COS0 3 

sin6 

-sins 3 

cose 


Combining (30) and (31) gives 

B -1 T T T B 

pAw p = P 1 P 2 P 3 Aw 
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T "“B 

The term Aw is to be examined closely, 
below that 0^ equals C. From (12a); 


It is shown 


„ J - J 

0 O = -S-X x 

3 J J 

y x 


cos 0, 


or 


* J y J x H „ 

6 3 = j^ OS0 2. 

y x 


From the first of (9) , 


H 

w = —cose 
x J 2 

x 


Thus 



or, from (24) and (27) , 


0 3 = Ct + 0(0) 

* 

It was previously assumed in determining © 3 that the initial 
value 0 3 (O) equalled zero. This is valid for a symmetric body 
since the Y and Z principal axes can be considered to lie any- 
where in the YZ-plane. This assumption is not correct for a 

* k 

nonsymmetric body. The calculation of 0 described earlier 

continues to be valid if © 3 is defined to be the final value 

of 0_ minus the initial value 0(0) . 

3 3 

It is seen from (29) that the multiplication of F(t) + Au(0) 
—xCt 

by e in (28) is equivalent to a rotation of the Y and Z axes 
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T 

through the angle Ct about the x-axis. Since describes 
the rotation of 6^ (equal to Ct + 0^ (0) ) about the negative 
x-axis, it follows that: 


_ T -B. _ T . , 

P 3 Aw - P 3 (0) 


Aw, 


F (t) + Aw (0) 

y y 

F ( t) + Aw (0) 
z z 


(33) 


where P (0) is the initial condition of P . By combining 
^ ^ 

(32) , (33) , and (46) , the perturbed rotation is obtained 
as 


AP 


■ C w 


( 0 ) 


Aw x 

F (t) + Aw^(O) 

F (x) + Aw (0) 
z z 


The integrand consists of constants and products of trigon- 
ometric functions of Ct, 2Ct, and 0^t . The integration can 
therefore be done analytically although it is rather involved. 


2. 2. 2. 2 Stability Analysis for Special Case and for Simplified 

Guidance Law 

This section discusses the stability problem using 
the simplified guidance law where the shuttle is first rotated 
in roll until its z-axis intersects an extension of the target 
vehicle docking hatch axis and then simultaneous translation 
and rotation about the intermediate Y or pitch axis is initi- 
ated. The vehicle arrives at an aim point with proper pitch 
orientation and then is rotated about its x or roll axis to 
complete the maneuver (This discussion also pertains to the 


* 

Equation 


(46) 


appears in section 2. 2. 2. 2 following 
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special case when rotation about the y-axis only is demanded 
when employing the more sophisticated desired guidance law. ) . 

Rotation about the axis of minimum inertia or of maximum 
inertia is stable, but rotation about the axis of an inter- 
mediate inertia in unstable. These conclusions follow from 
Euler's equations (4) repeated here (for zero torque) 


x x 


y y 


z z 


+ 

(j 

3 

3 

b 

1 

= 0 


z 

y y z 


+ 

(J 

- J ) 0) 0) 

= 0 


X 

Z Z X 


4- 

(J 

1 

<4 

s 

8 

= 0 


y 

x x y 



If the initial condtions are 


(34) 


w (0) = w (0) = 0 
x z 


a) (0) nonzero 

y 

then w and w remain zero and w retains its initial condition, 
x z y 

Let the reference motion be a constant angular velocity about 
the y-axis. If this is perturbed by small initial w and w , 

X z 

the resulting angular velocity components are 

Aw x ' w y + Aw y ' Aw z 


These perturbations are to be determined by a first order 
analysis. The second equation of (34) becomes 


J y (w y + Aw y ) + (J x - J z )Aco z Aaj y - 0 
or, to first order. 


from which Aoj^ 
(34) are; 


V ffi y 


is constant. 


= 0 

The first and third equations of 
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X X 

J Aw 
z z 

or, to first order. 


+ (J 

- J ) (w„ + Aw. 

z 

y y 

+ (J 

- J ) (w„ + Aw 

y 

y 


j - j 

Aw 

= -iL— ~.?w Aw 

X 

J x y 


j - j 

Aw 

- ,y M aw 

z 

J z y : 


x 


( 35 ) 


Differentiation and elimination of the first derivatives gives !■ 

- J„ J. - J. 


Aw, 


- y 


Z X 


X 


X z 

J J - J 


Xcj 2 Aw 

J - y x 


(36) 


Affi„ = JL——Z * 
z 


Xw 2 w„ 

z y a 


-j— ^i)_Aw 


In order that the above equations can be used without change 
of parameters such that the three conditions of can be studied 
assume that 

(Condition 1) J y < J z < J x or J < J x < J z 

so that the reference rotation occurs about the axis of least 
inertia. Rewriting (36) in terms of positive coefficients. 


J - J J ~ J 
a *• _ z y x y 2 

Aw x = - ' J„ — j - 


X 


to Aio 
• y x 


Ato - z J * ~ J y ,, 2 


X 


^y A “z 


and the angular velocity perturbations are sinusoidal and 
bounded. Next assume that 

(Condition 2) J < J < J or J < J < J 

z x y x z y 

so that the rotation occurs about the axis of greatest inertia. 
Then 
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then 


J - J J - J „ 

... y z y x 2 . 

Aw = — — — = * — = a) Aw 


x 


J 2 y x 


Aw 


J - J J - J „ 

Y z y x 2 a .. 

= — ^ — - d — w Aw„ 

J J y z 

x z -* 


and here also the perturbations are sinusoidal. Now assume 
that 


(Condition 3a) J < J < J 

z y x 


so that the rotation occurs about the axis of intermediate 
inertia. Then the coefficients in (36) are positive and 
the angular velocity perturbations are exponential and un- 
bounded. Similarly for the case of the SSV studied 


(Condition 3b) 
then 


where 


J < J < J 
x y z 


Aw = K K w Aw 
x x z y x 


Aw = K K w Aw 
z x z y z 


(37) 




(38) 


The specific question that occurred concerned the possibility 
of the shuttle pitching about its y-axis (the axis of inter- 
mediate inertia) and it is this case which is analyzed below. 

Let 

k = /iTTTw (39) 

x z y v 

then (37) and (35) become 
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( 40 ) 


and 


Aco = k Aco 
X X 


Aco = K A(j0 
z z 


4 “x = - K x"y A “x 


Aw = -k w Aw„ 
z z y x 


The solution of (40) is 


(41) 


Aw = Aw (O)coshKt + i-Aw (O)sinhKt 

XX K X 

Aw = Aw (O)coshKt + —Aw (O)sinhKt 

Z Z K Z 


The initial values of the derivatives are available from (41) ,and 

Aw = Aw (O)coshKt - /K /K Aw (O)sinhKt 
XX X z z 

(42) 

Aw = Aw (O)coshKt - /K /K Aw (O)sinhict 

Z Z Z X X 

These are the angular velocity perturbations caused by initial 
deviations. The equations are valid for small values of Aw 

X 

and Aw whereby second and higher order terms may be neglected, 
z 

The next task is to solve a differential equation for the 
perturbation of the resultant rotation from the reference rota- 
tion occurring about the shuttle's y-axis. A convenient equation 
is 


p = ^pw B (43) 

where p is the quaternion of rotation defined as 

p = A + p (44) 

and 


A = cos|- 

- . 0 
p = nsxn^- 
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where n is the unit vector along the axis of rotation from 

the shuttle's initial orientation to its orientation at time 

t and 9 (measured about n) is the angle between the two 

-”B 

orientations. Here w denotes specifically the body's 
components of w and p is the derivative of p with respect 
to the body's axis frame. The perturbed equation is 


Ap = ^-(Ap« B + pAu) B ) 


or 


A * 1 A ” B 1 a “B 

Ap - — Apto = ~PAto 


B 


where the components of Aco are given by (42) . 

- -B . 
for w gives 


(45) 

Solving (43) 


-B _ -1. 

to - 4p p 


Since 


-1 . 
p p = 1 


this is equivalent to 


-B 

to 


= -2 


d£ 


-1 


dt 


and substitution into (45) gives 


. . dp" 1 1 -B 

AP + A P g t P = ^PAto 

-1 


Multiplying on the right by p , 


-1 


1 -B -1 


. -1 dp _ 

APP + A P g t - = -JPAto P 
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or 


—(App” 1 ) = |pAw B p “ 1 


This integrates into 


APP 


-1 


i p - B -i 

- ~2 \ PAw p dx 


and 


AP = f 


r>t 


-B 

pAw p dx 


\J o 


p 


(46) 


The integrand is the transformation from the body components 
of Aw to the inertial components. 


-B -1 -B 

pAw p = MAw 


(47) 


where 


M = 


cosw x 

y 


-smw t 

I Y 


0 

1 


sinw t 

y 


COSW T 

y 


Then, from (42) , 

— b —l r - 

pAw p = Aw (0) coshKxcosw, t -* /K /K Aw (0) sinhxxcosco x 
x y x z z y 


- ^ /K Au (0) sinhKxsinw t + Aw (0) coshicxsinw x] I 

z x x y z y | 

+ |-Aw (0) coshKxsinw t + /K /K Aw (0) sinhicxsinw x 
U X y x x z y 

- /K /K Aw (0) sinhKxcosw t + Aw (0) coshtcxcosw x| k 

z x x y z yj 


Each component is a linear combination of 
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COShKTCOSW T 

Y 

coshKxsintjo X 

Y 

sinhKTcosco x 

Y 

sinhKTsinw x 

Y 

It is next shown that the integral of such a combination is 
likewise a linear combination of the samo functions. Let 

F = A, , coshicxcosw x + A coshKX sinw x 
11 y 12 y 

+ A„, sinhKxcosw x + A sinhKisinu x 
21 y 22 y 

where the A are arbitrary constants. Then 

dF 

— — = A. . (Ksinhicxcosw x - oo coshKXsinoj x) 
dx li y y y 

+ A -^2 ( Ksinhicxsino) x + w^coshicxcosa)^.x ) 

+ A_ n (KcoshKxcosw x - a) sinhKxsinu) x) 

21' y y y 

+ A„ - ( Kcoshicxsinco x + w sinhKxcosw x) 

22 v Y Y 


or 


where 


dF 

— — = B . coshicx cos co x + B cosh<x sin U T 

dx 11 y 12 y 

+ sinhicxeosw x + B„_ sinhKX sinw x 
21 y 22 y 


B. . = w A + kA 
11 y 12 21 


B 12 = + Kfl 22 
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B 21 = KA 11 + " y A 22 


B 22 kA 12 w y A 21 


If the B are given (as in the present problem), the A. . are 
1 J x j 

obtained as 


KB 21 - Vl2 


2 2 

K + 03 

Y 


kB 22 + w y B ll 


2 2 
K + 03 

Y 


KB 11 * W v B 22 


2 2 
K + 03 

y 


KB 12 + “v B 21 


2 2 

K + OJ 


Letting 


F = F i + F k 
X z 


-B 

pAu) p dr 


it is seen from the preceding formulas that 

F - A coshKtcosoj t + A. -coshKtsinw t 
X ±1 y 12 y 

+ A s inh k t c o s w t + A sinhKtsinw t - A„ , 
21 Y 22 y 11 


-K/K /K Ago (0) - 00 A 03 (0) J A 03 (0) 

7\ X Z Z V Z _ Z z 

11 k 2 2 ~ ~J ~ 

K. -f- 0) V V 

Y r r 
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X 


X 



Similarly 


F = C„ , cosh Ktcosw t + c, _ cosh Kt. sin w t 
z 11 y 12 y 


+ C ,sinh«tcosco t + C. -sinhictsinco t - C_ _ 
21 y 22 y 11 


where 



y 


so that 


F = A. ^cosh Ktcoso) t - A, .coshicTsinw x 
z 12 y 11 y 


+ A 22 K-sinhKtcosw t 


A _ . s inh k x s inco x 
21 y 
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Finally, from (46) and (44) 


or 


and 


Ap = ~F ( A + p j) 


Ap = j(AF + F x j) 


Ap = ^ A(F I + F k) + p (F k - F I) 
2 {__ x z H x z __ 


or 


Ap = - ( AF - pF ) i + (AF + pF )k 
2 1 x ■ z z K x 


3 


Substituting for A and p in terms of oi^t. 


Ap = 


03. 


03 y t OJy 1 - _ 03 y t 

(F cos-*— - F sin—*—) i + (F sin—*— + F cos . 

X 2 Z 2 X 2 Z 2 


1,3 


This equation becomes somewhat involved when the formulas for 

F and F are substituted into it, A simplification follows. 
X z 

In matrix-vector form 


Ap = t^F 


(48) 


where 


M i - 


03 t 


COS 


sxn 


03 t 

_Z_ 


0) t 


-sin- 


COS' 


03 t 

,_JL_ 
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The components F and F can themselves be expressed in terms 

X z 

of another vector G , 


where 


F = M 2 G - A 


(49) 


M 2 = 


cos co t sinco t 

y y 


■sinco t cos oo t 


A = 


l ll 


A 


12 


y . 


g = 


G 


x 


G^ = A^coshtct + A^sinhict 


G = A, O coshict + A„~sinhKt 
z 12 2 2 

Substituting (49) into (48) 

Ap = i(M 1 M 2 G - M-jA) 

which becomes 







— 

—■ 


— ** — * 


00 t 

to t 




co t 

to t 




o 

0 

tn 

• y 
sm \ 


G 

X 


y 

cos \ 

• y 
-sm \ 


A n 

1 





1 





2 





2 






CO t 

00 t 




00 t 

to t 




-sm \ 

y 

co Hr 


G 

z 


• y 
^sm \ 

y 

cos T 


A 12 


— 

— 




— 

— J 

W — t 
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Then 


, 0) t U) t 

Ap x = 2 (G x " A ll )co Hr + (G z + A 12 )sin-lT 

.. 0) t tot 

Ap z = 2 - (G x + A ll )sin “i" + (G z " A 12 )co5 “2^ 

2.2.3 Autopilot, Propulsion, and Vehicle Effects 

MIT has conceived a jet selection logic program for use 
with the autopilot which could be used on the SSV. This pro- 
gram is proposed for operation during several phases of the 
SSV mission including the docking operation. 

Because of the special nature of the guidance law, the 
thresholding of engine (RCS) firings might well be accomplished 
by the guidance computer. This problem should be reviewed in 
later studies. 

2.2.4 Orbital Disturbances and Effects 

Two point masses in separate orbits have relative dynam- 
ics which exist between them because of the presence of the 
gravitational field. An approximate expression for the orbital 
mechanics involved is: 

r - ER~ 2 3 y (p • |) + a T 

where , 
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r relative position (subject-sensor) 

unit vector (earth center to either vehicle) 

R distance (earth qenter to either vehicle) 

a m thrust acceleration 
T 

E earth's gravitational constant 

4 

This equatxon has an accuracy of 1 part m 10 and appears 
to be sufficiently accurate for incorporation into box (8) of 
Figure 5 . 

2.2.5 Geometry Update Solutions 

The effects of the guidance outputs, autopilot, vehicle, 
and engine outputs and orbital disturbance effects should be 
utilized in the geometry update equations, box (1) , figure 5 
to close the simulation loop. Completion of the programming 
of this and the preceding would provide the capability for 
evaluation of the performance of the angle only and other 
docking sensor configurations. 

2.3 Kalman Filtering Assessment 

During the course of this program two approaches to deter- 
mine the enhancement Kalman filtering provided to the basic 
docking sensor data were employed. 

The first which was reported in the Summary and Current 
Status Report, dated December 9, 1970 is included herein for 
completeness : 

Let X be the estimated state vector 
* 

and E the correlation matrix of uncertainty in the state 
vector 
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Figure 14. Geometry for Kalman Filter Study. 


a is angle measured between two target courses 
h is a unit vector in plane of measurement perpendicular 
to one line-of-sight 
R is range to target 


The measurement update equations are 
X* = X + 


E b(a - 


E b + a 


m 
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and 


£. * | _ . . (g |ui l ), T . 

b * E b + a ' 
m 


where 


X 1 , E 1 = new estimate of state and uncertainty 
$ = angle calculated assuming old X 

= instrument measurement accuracy 
b = h/R 

* 

The procedure employed was to start with E large enough to 

— _ * 

represent a priori knowledge of X and to update X and E once for 

* 

each angle that can be measured. The resulting E matrix repre- 
sents the accuracy to which a sensor of accuracy cr can fix the 

m 

position under the given geometry. The la uncertainty in any 
direction y (such as range or elevation set) can be found by 
solution of the following equation: 

a = /(y E) -"ll 

Results of this analysis indicate marked improvements in 
position (and other) knowledge can be achieved as a result of 
employing estimation techniques for docking. See Table 2 for 
the presentation of the computed values of position and velocity 
uncertainties with Kalman filtering employed. 


Section 2.1 shows simulation results of position accuracy 
without the benefit of filtering. 


The second study, also previously reported, developed 
linearized equations around a nominal state consisting of 


1. Zero angular misalignment between sensor axes and 
target (inertial) axes. 
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TABLE 2 


Position and Velocity Uncertainties 


• Measurement accuracy 1 arc min 

• One independent measurement per second 

• Optical target perfect 

• AV application and measurement perfect 


RANGE 


POSITION SIGMA 
= LOS LOS 


VELOCITY SIGMA 
= LOS LOS 


200 ft 
10 
1 


10 ft 
0.01 
0 . 001 * 


0.5 ft 
0 . 001 * 
< 0 . 001 * 


0.2 FPS 
0 . 001 * 
< 0 . 001 ** 


0.01 FPS 
< 0 . 001 ** 
< 0 . 001 ** 


* Limited by optical properties of target and 
sensor to ~0.001 ft 

** Limited by AV application and measurement to 
"0.002 FPS 
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2. Zero angular rate between sensor and target axes. 

3. Zero relative linear velocity. 

4. Relative position vector having only the x-component 
non-zero. 

The target was in a 150 n mile orbit about a spherical 
Earth, and was in a perfect inertial attitude hold, with the 
x-axis out of plane and the z-axis initially up. No thrusting 
or limit cycling was assumed. A complete measurement incorpora- 
tion (azimuth and elevation for three target lights) was made 
every 1/2 second, and a total of ten complete incorporations 
were made at each value of range in a given set of runs. The 
target axis was assumed to be centered at light #1. The state 
vector for the problem consists of the relative linear position 
and velocity of the body with respect to the target and the 
relative angular position and velocity of the body with respect 
to the target, all expressed in body coordinates. 

The results indicate that the linear filtering technique 
predicts rms errors significantly lower than those obtained 
using the alternate deterministic method. The extremely small 
errors at ranges less than 50 ft, although not to be entirely 
trusted, do indicate the power of the measurements at these 
ranges and indicate that linear filtering techniques will lead 
to a successful docking. Of particular importance is the good 
linear position and velocity information perpendicular to the 
line-of -sight at large ranges. This should allow efficient 
velocity corrections to be made early in the mission to keep 
the vehicle within the operating cone.. An added advantage of 
the filtering technique is that it has at all times the (pre- 
dicted) covariance matrix of estimation errors. This information 
would be of particular value to an outer loop which must decide 
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when to alter the velocity along the line -of -sight. 

Results of this study are presented in tables 3, 4, and 
5. The parameters (position, velocity, attitude, and attitude 
rate) are calculated and are based upon estimates of the line- 
of-sight angles to the individual targets. Table 3 presents 
results that are comparable to the calculated results shown 
in Table 1 section 2.1} where raw sensor data was used as a 
basis of computation. The results shown in table 1 are based 
upon a single measurement whereas the results employing esti- 
mation techniques are rms values. 

A comparison of tables 4 and 5 show the improvement in 
estimation realizable with tighter initial conditions. Again 
the positional cross track uncertainties are small in compar- 
ison to the track uncertainties at long ranges and indicate 
lateral control is effective regardless. 
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3.0 Conclusions and Recommendations 


This study program has proven the functional feasibility 
of utilizing an angle or>ly sensor; operating in cooperation 
with a target array of known physical dimensions, mounted on a 
passive vehicle; during the automatic docking of large spacecraft. 
A parametric analysis is required to optimize the sensor/target 
configuration to ascertain such factors as sensor f ield-of-view 
scale change requirements, operating wavelength, target size and 
configuration, and other parameters for utilization during the 
docking mission. Effects of the operating limits for the sen- 
sor, the profile, vehicle configuration, background condition, 
and other factors should be reflected in the final sensor sub- 
system design. Benefits derived from Kalman estimation tech- 
niques were investigated during the study. The results 
show considerable promise for the utilization of these techniques 
where the angle only sensor concept is employed. 

A computer simulation program was conceived and partially 
implemented. The overall program was intended to simulate the 
complete automatic docking process from a given set of initial 
conditions to actual hard dock taking into account sensor per- 
formance, the guidance law, the active vehicle autopilot con- 
figuration, the vehicle response characteristics, and the orbital 
effects-all in closed loop simulation. It was intended that 
provision for the evaluation of several types of sensors be in- 
corporated into the simulation. 

Unfortunately the complete simulation was never accomplished 
because of the lack of availability of valid guidance equations 
until near the end of this program. Derivation of the guidance 
equations which provide commands for simultaneous control of 
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active vehicle translation and rotation which minimizes Av 
consumption and allows the docking maneuver to be performed 
safely and in a minimum amount of time was accomplished. 

Several alternative schemes for the guidance law were con- 
sidered during the course of the study. Equations for two 
alternative guidance methods and a related stability analysis 
are presented herein. Further information regarding the ve- 
hicle characteristics and control configuration, and the de- 
sired docking profile (s) are necessary before firm guidance 
law parameters can be established. 

It is recommended that the computer simulation be com- 
pleted in any future effort. A closed loop program would be 
an extremely useful tool for further analysis where many sets 
of sensor and system parameters must be examined. Such a tool, 
with proper variables, can be used to verify the performance 
of many different sensors with many autopilot and vehicle 
configurations under varied environments and with different 
guidance laws. Kalman filtering and other enhancement tech- 
niques should be included in the simulation because of the 
high accuracy that the docking of large space vehicles requires. 

Insofar as the guidance equations as discussed herein are 
concerned, it is recommended that future effort include: 

1. a comparison of the perturbed solution with the 
numerical solution of the exact (Euler's) equations for 
accuracy and number of solutions, 

2. devising a definition of the "best" solution (when 
two or more exist) , 
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3. an examination of the effect of gravitational torque 
on the shuttle, 

4. an examination of the effect of rotation of the space 
station. 

During this study it was assumed that the SSV onboard 
computer capacity was sufficient to adequately accomplish the 
docking operation. Inasmuch as the quidance equations were not 
developed until the end of the study, computer sizing was not 
accomplished. It is recommended computer requirements and 
sizing be accomplished in any future study. 

Finally it is recommended that the several sensor sub- 
systems under consideration for automatic docking be evaluated 
and the better candidates be designed for the specific mission 
and equipment. It Is only after the sensing equipment has been 
fabricated, calibrated, and tested that enough will be known to 
adequately implement its parameters into the computer simulation. 



